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SUMMARY OF THE REPORT 


This report presents the research results obtained from the research grant entitled 
“ Development of Advanced Control Schemes for Tclerobot Manipulators, ''funded by the 
Goddard Space Flight Center (NASA) under a research- grant with Grant Number NAG 
5-1 124. for the period between August 1st , 1990 and February 1st, 1990. 

This report deals with the kinematic analysis and control of a kinematically redundant 
manipulator, which is the slave arm of a telerobot system recently built at Goddard Space 
Flight Center fGSFCj to serve as a testbed for investigating research issues in tcler- 
obotics. A forward kinematic transformation is developed in its most simplified form, 
suitable for real-time control applications, and the manipulator Jacobian is derived using 
the vector cross product method. Using the developed forward kinematic transformation 
and quaternion representation of orientation matrices, we perform computer sim.ulat.ion 
to evaluate the efficiency of the Jacobian in converting joint, velocities into Cartesian ve- 
locities and to investigate the accuracy of Jacobian pseudo-inverse for various sampling 
times. The equivalence between Cartesian velocities and quaternion is also verified, using 
computer simulation. Three control schemes are proposed and discussed for controlling 
the motion of the slave arm end-effector. 




1 Introduction 


Recently research in the jura of kinematically redundant 1 manipulators has horn very 
aetive [l.S] hecaus(' they have many advantages as compared to non redundant manip- 
ulators. A robot manipulator is classified as kinematically ruhmdant if its number of 
degrees of freedom (DOF) is greater than that of task space coordinates. The extra 
DOFs enable the redundant manipulator to avoid singularities and obstacles, to keep 
the joint variables within their physical limitations, to minimize kinetic energy and to 
provide greater dexterity. Consequently the above advantages have' motivated robot 
designoi s to adopt redundant manipulators for tele'robots whie'h will re place or assist 
astronauts in performing operations in space. Goddarel Space- Flight Center (GSrC) is 
developing a Flight Telerobot Service 1 !' (FTS) te> carry out a variety e>f tasks including 
assembly of NASA space station and platforms, inspection, servicing anel maintenance 
on the space station etc. An integral part of the research facilities for the FTS project is 
a dual-arm telerobot system which consists mainly of a pair of mini-master controllers 
and a pair of slave- arms, each of which is a redundant manipulator possessing 7 DOFs. 
The telerobot system serves as a testbed for investigating research issues in t-elerobotics 
such as zero-g operation, trleoperated and autonomous control. dual-arm manipulators, 
advanced control of redundant manipulators, hierarchical control etc. [9]. 

In this import, we- present some- mathematical developments which will be' employed 
in computer simulations and real-time control of the slave arm motion. In particular, 
we will focus on the manipulator forward kinematics, differential motion analysis and 
propose thre-e control schemes for the slave arms. This repent is organized as fedlows. 
Next, section will give an overview of the- GSFC telerobot system and briefly describe the 
structure of the slave arm. Then the forward kinematic transformation for the manip- 
ulator is derived in its most simplified form using Denavit-Hartenbcrg notation. After 
that, we obtain the manipulator Jacobian using the vector cross product method and 
then discuss the pseudo- inverse of the Jacobian. Computer simulation is then conducted 
to evaluate the efficiency of the Jacobian in converting joint velocities into Cartesian 
velocities, to investigate the accuracy of the Jacobian pseudo- inverse for various sam- 
pling times and to verify the equivalence between Cartesian velocities and quaternion. 
Finally three control schemes are proposed and discussed for controlling the position 
and/or force the slave arm end-effector performing compliant and non-compliant mo- 
tion. 


2 The Redundant Manipulator 

GSFC recently has developed a dual-arm telerobot system which serves as a testbed 
[9] for investigation of research issues in telerobotics such as robot control algorithms, 
dual-arm teleoperation, dynamic simulation techniques, collision avoidance, end-effector 

'The term “redundant” is often used instead of “kinematically redundant” 
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design, and hierarchical control using high-level programming languages, etc. The main 
components of the system include a pair of slave arms, each of which is a Robotics 
Research Corporation (RRC) K-1G07 manipulator and a pair of G-DOF Kraft Mini- 
Master (KMM) hand controllers manufactured by Kraft Telerobotics, Inc. Figure 1 
shows the RRC K-1G07 manipulator which is a kinematically redundant manipulator 
possessing 7 DOFs. The slave arm motion can be controlled in a teleoperation mode 
by a human operator using the master arm system or autonomously controlled by a 
set of computer programs. Following the convention in [10], 8 coordinate frames are 
assigned to the manipulator as illustrated in Figure 2 showing the manipulator in its 
home configuration with all joint angle's being zero. Each it h frame {i} is characterized 
by its coordinate axes x„ y,, z, and its origin 0, for i = 0,1,2,. ..,7. The Dcnavit- 
Hartcnbcrg parameters for the assigned coordinate frames are listed in Table 1 given 
below: 
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Table 1: D-H parameters of the RRC K-1607 manipulator. 


3 The Manipulator Forward Kinematics 


In this section, we consider the forward kinematics of the above redundant manipula- 
tor. Forward kinematics is useful if one employs a Cartesian-space control scheme and 
measurements of joint variables are available from joint sensors. A forward kinematic 
transformation is developed to convert the 7 joint angles 0, for i=l,2,. . . ,7 of the manip- 
ulator into the corresponding position and orientation, referred here to as configuration 
of the manipulator end-effector frame, Frame { 7 }, with respect to the base frame, Frame 
{0}. The configuration of the ith frame with respect to the (i-l)th frame is represented 
by the following homogeneous transformation matrix: 
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for i=l,2 7 when- j _, R and | _l p represent the orientation and position of the it h 

frame expressed in the (i-l)tli frame, respectively. The transformation 7 T consisting 
of tin orientation matrix ( 7 ’R and the position vector 7 p expresses th*' conhgnrat ion of 
Fram*’ {7} with respect to Fiame {0} ami is computed by 


“T = “T \T §T 4 S T -;T ST. 


(3) 


Carrying out the matrix multiplications in (3) and performing intensive trigonometric 
simplifications we obtain 
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( 10 ) 
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and wo have used tlio compact notations, c, = cost?, and s, = sin#,. Wo also note 
that in (5)-(ll), i and d, for i=l,2,. . . ,7 arc manipulator parameters listed in Table 
1. Since matrix multiplications are avoided in (5)-(ll). the computation time for the 
forward kinematics is greatly reduced. As a consequence, the derived forward kinematic 
equations are highly suitable for real-time control implementation. 


4 Differential Motion Analysis 

This section is devoted to the analysis of the manipulator differential motion. In the 
following, we first compute the manipulator Jacobian using the vector cross product 
method and then discuss its inverse computation using the method of Moore- Penrose 
pseudo-inverse. After that, we review the quaternion representation of orientation which 
will be used in the computer simulation study. 


4.1 The Manipulator Jacobian 


To be compatible with the coordinate frame assignments according to the convention 
given in [10], the vector cross product method [11] is slightly modified and is applied 
to derive the manipulator Jacobian. According to [11] the manipulator Jacobian is 
obtained by 


J = 


Jl J2 J3 J4 J5 ^6 J 7 J 


( 12 ) 


where 


J, = 


b, x p, 
b, 


i=l,2,...,7 


(13) 


and b t , defined as the unit vector pointing along the axis of motion of Joint i expressed 
in Frame { 0 }, is given by 


b, = °R l R 


t-i 
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(14) 
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and p,, defined as the vector pointing from the origin of the ith-frame to the origin of 
Frame {7}. expressed in Frame {0}, is obtained from 


- 2Tx„ - “Tx„. i- 1 .2 7 ( 3 0) 

with 

x o = [0 0 0 1] T (17) 

and x indicates thr vector cross product. A Fortran program was written to compute 
the manipulator Jacobian J and because of the space constraint in this n port, only the 
first three columns of the Jacobian are given below: 
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4.2 The Jacobian Inverse 

The Cartesian velocity vector x(/) are related to joint angle velocity vector q(/) by the 
Jacobian J as 

x(Y) = Jq(/)- ( 20 ) 

The inverse solution to (20) which minimizes the weighted quadratic form q 7 W _1 q, is 
given by [14] 

q(f) = jJ yx(t) + (I- - jf v j)z (21) 

where j|j-, the Weighted Pseudo- Inverse of the Jacobian J is given by 


J' v = WJ 7 [JWJ 


7 1-1 


( 22 ) 


W, the W righting Matrix is a symmetric matrix, z denotes an arbitrary joint velocity 
vector and the second term of (21) belongs to the null space of J. Vector z can bo 
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selected for optimization purposes. When W — I and z — 0, then (22) reduces to the 
well-known Moore - Penrose Pseudo-Inverse of the Jacobian given by 

jt = (23) 

which provides the minimum norm least -squares solution. 


4.3 Quaternion Representation 

The Quaternion consisting of a scalar r/ and a vector s = [/? 7 £] 7 . also called Euler 
Parameters of an orientation matrix R specified by 
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is obtained by an operator Q defined by 

(r;,s) = Q{R} 

such that 

r/ = 4 bi + r 2 v + r 3a/2 

ft = (r 32 “ r 2 .'t)/ 4 '/ 

7 = (n3 - r 3 i )/4 t7 

£ = ( r 21 ~ r ’ 1 2 ) / 4 77 . 

On the other hand, an orientation matrix R can be computed from its quaternion 


by the inverse 

operator defined by 
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so that 
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Now considering two orientation matrices ?R and °R which represent the orientation 
of Frame {1} and {2} with respect to Frame {0}, respectively, we can write 


°R = °R JR- (30) 

In (30), since ^R is postmultiplied to ?R, jR represents a rotation of Frame {1} about 
Frame {1} to move Frame {1} to Frame {2}. ^R can also be interpreted as the orien- 
tation of Frame {2} with respect to Frame {1}. However if the rotation is performed 
about Frame {0}, then we should write 

°R = jR?R (31) 


(25) 

( 20 ) 
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where JR represents the rotation of Frame {1} about Frame {0} to bring Frame { 1 } t < 
Frame {2} and ran he computed from (31) as 


2 It - °R “ir 1 = !JR ”R r . (32) 

Suppose (7/|,Sj) and ( 1 ) 2 ^ 2 ) are the quaternions of jR and (III, respectively. Then 
the quaternion of lR can be expressed in terms of those of ^R and (JR as follows: 

6l) — 7/] I// + S^S2 ( 33) 


and 


6s — 7/j S 2 — y 2 s I + S* S 2 . 


(3d) 


Now w e are int ('rested in finding how the quaternion of JR are related to differential 
rotations introduced in [15]. According to [15], if the orientation difference between 
Frame {1) and Frame {2} is small then 
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where 6 r , 6 y , and 6 Z denote the differential rotations of Frame {1} made in any order 
about the x, y, and z axes of Frame {0}, respectively to bring Frame {1} to Frame' {2}. 
Comparing (31) and (35), we obtain 
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From (30) the differential rotations 6 X , 6 y , and 6 Z can be computed from the quaternion 
of 2 R by taking the quaternion on both sides of (30) using (20) and solving for 6 X% 6 y , 
and 6 Z as follows: 

6 X « 2 6(3 

6 y ~ 2 . (37) 

6 ; *2 

Equations given in (37) provides a relatively accurate computation of the rotation 
velocities if the quaternion of 1>R is given. 


5 Computer Simulation Study 

This section presents the results of the computer simulation study conducted to verify 
the above mathematical developments. The study is composed mainly of three parts, the 
first p;u't is devoted to investigate the efficiency of Jacobian in converting joint angle 




velocities to Cartesian velocities, the second to evaluate the accuracy of the pseudo- 
inverse Jacobian and the third to verify the equivalence between Cartesian velocities 
and quaternion representation. Computer simulation is repeated for various sampling 
times so that a maximum permitted sampling time can be established for an acceptable 
conversion accuracy. 


5.1 Part 1: Joint to Cartesian Velocities 

Figure 3 represents the computer simulation scheme used for Part 1 and Part 2. In 
the upper loop, a set of test joint angle trajectories are converted to the corresponding 
Cartesian trajectories using the derived forward kinematic transfox mation. The oiien- 
tation matrix ?R is used to compute the differential rotations by employing (35). In the 
lower loop, the joint velocities which are obtained by differentiating the test joint angle 
trajectories are supplied to the Jacobian which produces the corresponding Cartesian 
velocities. The Cartesian velocities obtained from the upper loop are then compared 
with those from the lower loop to compute the conversion errors. Figure 4 shows the 
error between the x-axis velocities p x j (from Jacobian) and p x for two different sampling 
times. The maximum error is about 0.5 inch/sec for a sampling time of 10 msec (indi- 
cated by solid line) and about 6 inch/sec for a sampling time of 100 msec (indicated by 
asterisk line). Figure 5 presents the error between the x-axis angular velocities u' x j and 
fjj x for sampling times of 10 msec (solid line) and 100 msec (dotted line). The maximum 
angular velocity errors are about 0.5 minch/sec and 5 minch/sec for sampling times of 
10 msec and 100 msec, respectively. 


5.2 Part 2: Cartesian to Joint Velocities 

In the lower loop of Figure 3, the Cartesian velocities provided by the Jacobian are 
supplied to the Jacobian pseudo-inverse which is computed by Equation (23) and whose 
outputs are compared with the joint velocities. Figures 6 and 7 show the joint angle 
velocities 6 u (from the pseudo- inverse) and for sampling times of 10 msec and 100 
msec, respectively. According to the obtained results, the pseudo-inverse docs not pro- 
vide adequate conversion of Cartesian velocities to joint velocities at a sampling time 
of 100 msec. The velocity conversion is excellent at a sampling time of 10 msec. 


5.3 Part 3: Quaternion Representation 

Figure 8 illustrates the computer simulation scheme used to verify the equivalence be- 
tween Cartesian velocities and quaternion representation. In the upper loop of Figure 
8, using Equations (33)-(34), we compute the quaternion of the orientation difference 

given by „ 

A°R = ?R(b) ?R (<,-i) ( 3§ ) 
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where 2R(/ f ) denotes the orient at ion matrix evaluated a the ith sampling during the 
computer simulation. In the lower loop, the quaternion ran be computed from the out- 
put of the Jacobian by employing Equation (37) and then compared with the quaternion 
of the upper loop to determine the deviations. Figures 9 and 10 show the simulation 
results of the errors of (solid line) and (asterisk line) for sampling times of 10 msec 
and 100 msec, respectively. In the case of 100 msec sampling time, the maximum errors 
for fi/i and are 15 minch/sec and 0.15 minch/sec, respectively and are negligible in 
the case of 10 msec sampling time. 

6 Proposed Control Schemes 

In this section, we consider the problem of controlling the compliant, and noil-compliant 
motion of the slave arm end-effector. When the slave arm performs non-compliant 
motion, i.e. without being in contact with the environment, it is sufficient to employ 
pure position control schemes whose error-correcting force's are computed based only 
on the position errors. However during a compliant motion mode in which the slave' 
arm end-effector is constantly in contact with the environment a hybrid position force 2 
control scheme which controls not only the position of the end-effector but also the 
contact force's it applies on the environment, should be applied. In the following, vo 
present and discuss three control schemes which have been under study for controlling 
the slave arm motion and briefly report some preliminary findings. 

6,1 Joint-Space Adaptive Control Scheme 

Figure 11 shows the organization of a joint-space control scheme which has been consid- 
ered for controlling the non-compliant motion of the slave arm. In the control scheme, 
actual joint angles measured by 7 joint sensors are compared with desired joint angles 
which are obtained from desired configuration of the slave arm end-effector through the 
inverse kinematics. The joint variable errors then serve as inputs to a set of proportional- 
derivative (PD)- controllers whose gains are adjusted by an adaptation law so that the 
error-correcting joint forces provided bv the controllers track the slave arm end-effector 
along a desired path. The adaptation law was derived using the Lyapunov theory and 
the concept of model reference adaptive control (MRAC) under the assumption that 
the slave arm performs slowly varying motion. From the fact that the derived adapta- 
tion law does not have to evaluate the slave arm dynamics, it is computationally fast 
and very attractive to real-time control. Computer simulation results reported in [G] 
showed that the slave arm end-effector under the control of the above scheme can track 
several test paths with minimal tracking errors under sudden change in payload. The 
developed joint-space control scheme is currently implemented by GSFC for real-time 
control of the slave arm motion. 

2 1 n this report, “position" implies both “position and orientation’’ and “force” both “force and torqin ". 
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6.2 Cartesian-Space Adaptive Control Scheme 

Ail adaptive control scheme in Cartesian spaa- is presented in Figure 12. As tin- figure 
shows, feedback information of the actual joint variables are converted into the cor- 
responding Cartesian variables by the forward kinematic transformation. The actual 
Cartesian variables are then compared with the desired Cartesian variables representing 
the desired configuration of the slave arm end-effector, and tin- corresponding Cartesian 
errors are supplied to a set of PD-cont rollers whose gains are adjusted by an adaptation 
law. The adaptation law is designed such that the joint forces which arc obtained by 
transforming the Cartesian forces produced by tin- adaptive PD controllers using tin- 
Jacobian transpose will track the end-effector along desired paths. Extending the devel- 
opment in [G], an adaptation law was derived and presented in [5] under the assumption 
of slowly- varying motion. Computer simulation study is currently conducted to investi- 
gate the performance of the Cartesian-space control scheme and simulation results will 
be reported in [7] 

6.3 Hybrid Position/Force Control Scheme 

Figure 13 presents a hybrid posit ion /force control scheme whose structure is similar to 
that introduced in [12] except that the controller gains of the current control scheme 
are adjusted by an adaptation law. As Figure 13 shows, the control scheme mainly 
consists of the two control loops, the upper loop for position and the lower for force 
control. A (GxG) diagonal compliance selection matrix S whose main diagonal elements 
for i = 1,2,..., 6 assume either 1 or 0, allows the user to select which DOF to be 
position-controlled and which to be force-controlled by setting the element properly, 
namely s,, = 1 for the ith DOF to be force- controlled and .s„ = 0 for the it h DOF to 
be position- controlled. In other words, the hybrid posit ion /force control scheme allows 
independent and simultaneous control of position and force. The adaptation law which 
adjusts the gains of the PD-cont rollers of the position and force control loops so that 
the end-effector can follow a desired path while applying desired contact forces on the 
environment despite disturbances such as varying environment stiffness, is currently 
under intensive study. Results found for the adaptive hybrid posit ion/force control will 
be reported in [8]. 

7 Conclusion 

In this report , we have considered the kinematic analysis and control of a 7 DOF manip- 
ulator serving as a slave arm of a telerobot system developed at GSFC to investigate the 
feasibility of telerobotic applications in space. A forward kinematic transformation for 
the manipulator was derived and simplified for real-time implement at ion. Employing the 
method of vector cross product, we obtained the manipulator Jacobian and computed 
its inverse using the Moore- Penrose pseudo-inverse method. The concept of quater- 
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nion was reviewed for presenting the orientation of the manipulator end-effector and 
relationship between quaternion and differential rotations was developed. Computer 
simulation was performed to verify the efficiency of the Jacobian in converting joint 
velocities to Cartesian velocities and to investigate the accuracy of Jacobian pseudo- 
inverse. The equivalence between differential rotations and quaternion was also verified 
through computer simulation. Simulation results showed that the maximum sampling 
time which ensures the efficiency of the Jacobian, its pseudo- inverse, and the quaternion 
representation was about 10 msec. Three control schemes was proposed and discussed 
for controlling the motion of the slave arm. Current and future activities focus on the 
implementation of the proposed control schemes. 
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Figure 1: The RRC K-1607 slave arm 
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Figure 2: Assignment of the coordinate frames 
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Fieure 3: Computer simulation scheme for parts 1 and 2 r , 

r Figure 4: Errors of x-axis velocities 

sampling times: 10 msec (solid line), 100 msec (**- line) 
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Figure 5: Errors of x-axis angular velocities 

sampling times 10 msec (solid line), 100 msec (dotted line) 
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Figure C: Velocities of joint angl*- 1 for sampling time 
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Figure 7: Velocities of joint angle 1 for sampling time Figure 8: Computer simulation scheme for Part 3 

of 100 msec, 6\j (dotted line), 9\ (solid line) 
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Figure 11: The joint-spare adaptive control scheme 
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Figure 10: Quaternion errors for sampling time of 
100 msec, W (solid line), (**-line) 


FORWARD 

KINTMaTIRS 


X-MM \ f ,i: 


K p ( t ;[ 


W N 

vu 


ADAPTATION 

LAW 


Figure 12: The Cartesian-space adaptive control scheme 
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Figure 13: The hybrid adaptive control scheme 














